function [ distance ] = getEuclideanDistance( point, plane )
%GETEUCLIDEANDISTANCE Returns the euclidean distance from the specifie
%point to the plane
%   POINT is a column vector that contains the x, y, z coodinates
%   PLANE is a column vector that contains the plane coefficients where the
%   plane is defined as Ax+By+Cz+D=0


distance = abs(point(1)*plane(1) + point(2)*plane(2) + point(3)*plane(3) ...
    + plane(4))/sqrt(plane(1)*plane(1) + plane(2)*plane(2) + plane(3)*plane(3));

end

